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ABSTRACT 


The dynamic model of the robot manipulator contain from equations, these 
equations are nonlinear and contained from variations parameters due to 
variations in load, friction, and disturbance. The conventional computed 
torque (PD and PID) controllers are not highly suitable for nonlinear, 
complex, time-variant systems with delay. In this paper, the fuzzy logic 


controllers (FLC) has been used because it is efficient tools for control of 
nonlinear and uncertain parameters systems. This paper aims to design a 
fuzzy logic controller for position control of a PUMA 560 robot manipulator. 
Based on simulation results we conclude that the performance of the fuzzy 
logic controller in term of position tracking error in case of disturbance or 
load is better than the conventional computed torque (PD-CTC and 
PID-CTC) controllers. 
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1. INTRODUCTION 

The motion of a mechanical manipulator described using dynamic equations, these equations are 
highly non-linear and complex. Therefore, it 1s very difficult to implement real-time control based on a 
detailed dynamic model of a robot, the non-linearity of robot manipulator as centrifugal, friction and 
gravity make a disturbance in this case the conventional control is not effected to control of the robot 
manipulator. A better solution to the complex control problem might result if human intelligence and 
judgment replace the design approach of finding an approximation to the true robot system [1]. 

The fuzzy logic controller can be used to overcome this problem. This is because the performance 
of fuzzy logic controllers are better than a conventional controller because a fuzzy logic algorithms 
do not require a detailed mathematical description of the dynamic model to be controlled, and 
the fuzzy logic controller consider as intelligent controller especially in the non-linear system. Therefore, 
the implementation of the fuzzy logic controller should be computational less demanding and the position 
control of a Puma 560 robot manipulator can be achieved by using a fuzzy logic controller. Computed 
torque control (CTC) is effective with a nonlinear system and uses in robot manipulator for controlling, 
it is applying feedback linearization to nonlinear system for computes the torque needs for the arm, it works 
well when all dynamic and physical parameters are known but if the robot has a dynamic parameter 
variation, then the performance of the controller will not be acceptable [2]. 

Zadeh in 1965 presented his paper on fuzzy sets and fuzzy logic he was the first one use the theory 
of the fuzzy set and fuzzy logic [3], and introduce the concept of linguistic variable in 1973, Zadeh showed 
that fuzzy logic in contrast classical logic may take values between false and true, in classical set theory 
definition of membership function does not matter, but the number belongs to or does not belong to the set, 
yes or no and also the zero or one takes on the value, this approach is not appropriate in many life 
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applications like the set aged or the set of temperature, but the element in the fuzzy set contains moving 
values between 0 and 1, meaning that elements of these sets not only represent true or false value but also 
represent the degree of truth or the degree of falsity of each input [4]. 

The PUMA 560 robot is an abbreviation for (Programmable Universal Manipulator for Assembly) 
released in 1978 was the first modern industrial robot and became desperately popular, it is an industrial 
robot, this robot has 6 degrees of freedom with 6 rotational joints, the Puma 560 was used for research in 
the 1980s and it was a very common laboratory robot, we used a lot in research because it has been well 
studied and it is parameters well-known have been described as "white mice" in research robots [5]. 


2. THE PUMA 560 ROBOT MODEL 

The specification of the Puma 560 robot manipulator used in this paper is from the paper of 
Armstrong, Khatib, and Burdick [6]. In this paper, we used the Robotics Toolbox for MATLAB created by 
Peter Corke in Australia to simulation and implementation of the proposed controllers for control in 
the position of the Puma 560 robot manipulator [7]. 

To defined the modified D-H parameters we used this command Puma 560 akb and description 
creates the robot object used this command P560m, which describes the kinematic and dynamic 
characteristics of an animation Puma 560 robot manipulators [8]. In this paper, the modified D-H 
parameters have been used. Craig [9] was the first one used the modified D-H parameters in 1986. 
The specifications of kinematics taking from the paper of Armstrong, Khatib, and Burdick. In the robotics 
toolbox, the actuators have been included in the dynamics model of a Puma 560 robot manipulator. 
Figure 1 shows the Puma 560 robot manipulator according to specification of Armstrong, Khatib and 
Burdick and used the modified D-H parameter. 





Figure 1. The puma 560-AKB 


3. CONTROLLER DESIGN 
3.1. PD Computed torque controller 
The motion of the robot describe by (rigid body dynamics): 


t=M(q)q+V(q,g)+F (4,4)+G(q) (1) 


where; 

M(q) Inertia matrix 

V(q,gq) Centrifugal and Coriolis terms 

F(q,q) Friction term 

G(q) Gravity terms 

One way to select the control signal u(t) is as the proportional plus derivative (PD) feedback, 
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u=—kve -kpe (2) 

Then the full input for a Puma 560 robot arm (Figure 2) becomes, 
t=M(q) (Gd +kvé+kpe)+N(q.4) (3) 


Nq,4)=V (4,4 )+F(g )+G(q) (4) 


This controller is shown in Figure 3 with ki=0. 
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Figure 2. The puma 560 robot Arm with PD-CTC 
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Figure 3. The PD computed torque controller [7] 


In this simulation we used some blocks from Peter Corke, Robotics Toolbox, as following: 
Jtraj: the purpose of this block is to compute a joint space trajectory between two joint coordinate poses. 
The command inside the block is: 


[q qd qdd]=jtraj(q0,q1,n) (5) 


RNE: the purpose of this block is to compute inverse dynamics by Recursive Newton-Euler method. 
The command inside the block is: 


tau=rne(robot,q,qd,qdd) (6) 
Puma 560-AKB: the purpose of this block is to create a Puma 560 robot. The convention of this robot 
takes from Armstrong, Khatib, and Burdick. This robot used Craig's modified D-H parameter. 


Robot plot: the purpose of this block is graphical robot animation. The command inside the block is: 


plot(robot,q) (7) 
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3.2. PID Computed Torque Controller 

We noted PD computed torque control is very effective when all parameters for the arm are known 
and no disturbance qtd, from classical control theory if disturbances are constant the PD control gives a 
nonzero steady-state error, for making the system type (1) we including an integrator in the feedforward 


loop using PID computed torque controller [10] as in Figure 4. Figure 5 shows The Puma 560 robot arm 
with PID-CTC. 


E€ =e (8) 
u=—kvė—kpe—kie (9) 


where the arms control becomes as 


t=M(q)(dd+kvé+kpe+kis)+N(q,q) (10) 
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Figure 5. The Puma 560 robot arm with PID-CTC 


3.3. Fuzzy logic controller 
The next steps showing the method to design the fuzzy logic controller. 
— Define the input and output to FLC (Figure 6), there are two inputs of FLC, the error e(t) and change of 
error Ae(t) and one output is a control signal u(t) to the plant (Figures 7 and 8). 
— Fuzzifying the input and the output variables (Figure 9). 


— In the design, we chose 2 input with 7 membership function and 1 output with 7 membership function 
(Figure 10). 
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— Inthe design, the membership function selected from the negative big NB to the positive big PB. 

— Chose the inference mechanism rule to find the relation between the input and output, in this paper we 
used the Mamdani inference mechanism 

— Defuzzifying the output variable of the fuzzy mechanism, defuzzification method was used in this paper 
center of gravity (COG). 

NB means Negative Big, NM means Negative Medium, NS means Negative Small, ZE means Zero, PS 

means Positive Small, PM means Positive Medium and PB means Positive Big. The rule base is in Table 1. 


t=M (q)(qd Hfuzzy) +N(q,ġ) (11) 






Out1 







In2 


Fuzzy Logic 
Controller 


NF/Puma560-AKB q 






-ra desired joint 

7 vied acceleration 
ajectory 

(demand) 


Robot robot state 
(actual) 


Fuzzy Logic Controller 


Figure 6. The puma 560 robot Arm with FLC 
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Figure 7. Membership function of e(t) 
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Figure 8. Membership function of Ae(t) 
Fuzzy logic controller design for PUMA 560 robot manipulator (Abdel-Azim S. Abdel-Salam) 


78 o ISSN:2089-4856 


j Fuzzy Logic Controller | 
~ For DC Motor 1 


Position Errors aa Fuzzy Logic Controller 2 
we For DC Motor 2 


Fuzzy Logic Controller 3 
For DC Motor 3 
Fuzzy Logic Controller 4 
For DC Motor 4 
Ca TAAN 


l Fuzzy Logic Controller $ 
Velocity Errors | For DC Motor 5 


MA 


Fuzzy Logic Controller 6 
For DC Motor 6 











CO 


L 


Output Control Signal 


Figure 9. The fuzzy logic controller subsystem 
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Figure 10. Membership function of output 


Table 1. Rule base 


Output Change of Error 
NB NM NS ZE PS PM PB 
Error NB NB NB NB 
NM NM NM NM NM NM 


NS NS NS NS NS NS NS NS 
ZE NS NS NS ZE PS PS PS 
PS PS PS PS PS PS PS PS 
PM PM PM PM PM 
PB PB PB 


4. SIMULATION RESULTS 

To testing the Puma 560 robot manipulator, the joint desired input angles are 
0 final=[90°, -90°, 90°, 45°, 66°, 15°] with the initial position of the Puma 560 robot manipulator is 
the zero position 9 imitial=[0°, 0°, 0°, 0°, 0°, 0°]. 
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4.1. Without disturbance 
The performance of PD-CTC, PID-CTC, and FLC without disturbance are good as shown in 


Figures 11-13, respectively. 


Position Tracking Curve of the Joint Angle q5 with PD-CTC 
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Figure 11. Position tracking curve of joint q5 with PD-CTC 


Position Tracking Curve of the Joint Angle q5 with PID-CTC 
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Figure 12. Position tracking curve of joint q5 with PID-CTC 
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Figure 13. Position tracking curve of joint q5 with FLC 


4.2. With disturbance 
For testing the Puma 560 with disturbance, we chose the maximum torque on each 


joints for computation the disturbance torque that needs for add to the model, we used the program 
shows in Figure 14. We take 10% from the maximum torque to get on the disturbance torque. 
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td=[3.95 -9.87 0.56 -0.095 -0.122 0.031]. Puma 560 robot using PD-CTC, PID-CTC, and FLC are shown 
in Figures 15-17 respectively. 


Command Window 
>> = This Program about how to Compute The Torque that needs for PUMA 560 


% First we define the initial Pose 
qi=[0 0 0 0 0 0] & gi means initial joints 


# Now we define the final Pose 

qf=[1.5709 -1.5709 1.5709 0.7854 1.1519 0.2618] 
% qt means the final joints 

# Now we define Joint space trajectory 

t=[(0:0.5:5]; @ trajectory time is 5 second at steps of 0.5s 
[q,qd,qdd]=jtraj(qi,qf,length(t)) ; 

eq Means Joint Position 

ł qd Means Joint Velocity 

# qdd Means Joint Acceleraction 

= Now compute the Torque Q 


Q=p560m.rne(q,qd,qdd) # Q is the joint torques 
+ RNE is the recursive Newton-Euler method 





Figure 14. How to compute the torques 


Position Tracking Curve of the Joint Angle q5 by PD-CTC with Disturbance 
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Figure 15. Position tracking curve of joint q5 with PD-CTC 


Position Tracking Curve of the Joint Angle q5 by PID-CTC with Disturbance 
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Figure 16. Position tracking curve of joint q5 with PID-CTC 
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1.2 F |—— Desired q5 
— Actual q5 


Position Tracking Curve of the Joint Angle q5 by FLC with Disturbance 
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Figure 17. Position tracking curve of joint q5 with FLC 


4.3. With load 
For testing the Puma 560 with load, we added load to the model this load equal 6 kg using this 
command 


P560m.payload(6,[0, 0, 0.1]) 
To remove load we used this command 


P560m. payload (0) 


4.4. The errors position tracking curves 

The positions tracking curve of Puma robot using PD-CTC, PID-CTC, and FLC are shown in 
Figures 18-20. The Figures 21-23 show the errors signals of the position tracking curves of the controllers 
PD-CTC, PID-CTC, and FLC with disturbance, respectively. 
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Figure 18. Position tracking curve of joint q5 with PD-CTC 


Position Tracking Curve of the Joint Angle q5 with PID-CTC with Load 

















1.2 F Desired q5| | | 
< 
—— Actual q5 
1 | + + + + + + + 
@ 0.8 H | l l | l i 
= 
& 
ao) 
we 0.6 
D p 
20.4 | | | | | | 
< 
0.2 H a 
0 
li | i | i Í | | ! 
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5 


Time (seconds) 
Figure 19. Position tracking curve of joint q5 with PID-CTC 
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Position Tracking Curve of the Joint Angle q5 with FLC with Load 





© 
fo) 








Angle (Radians) 
O 
[o>] 


























0 0.5 1 1.5 2 2.5 3 3.5 = 4.5 5 
Time (seconds) 


Figure 20. Position tracking curve of joint q5 with FLC 
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Figure 21. The errors tracking curves of PD-CTC with disturbance 
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Figure 22. The errors tracking curves of PID-CTC with disturbance 
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Figure 23. The errors tracking curves of FLC with disturbance 
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5. DISCUSSION 

Note from the simulation that performance of PD-CTC and PID-CTC without disturbance are 
good, but when add the external disturbance, we note the PD-CTC and PID-CTC are Not good because 
disturbance torques due to variations in load, coupling and friction that act on the joint. In this case 
the control problem becomes more difficult and The PD-CTC and PID-CTC are not highly suitable for 
Nonlinear systems therefore, we used fuzzy logic controller 

To overcome on this problem. When we added the disturbance torque the tracking error has 
increased in the PD-CTC and PID-CTC, but with FLC the tracking performance is good along the path. 
When we added the load we note that it is affected on the joint 5 and the tracking error has increased in 
joint 5 in PD-CTC and PID-CTC, but with FLC the joint 5 achieve good tracking performance along 
the trajectory. From the simulation, we prove that performance of the fuzzy logic controller with 
disturbance or load is better than another PD-CTC and PID-CTC performance with disturbance or load for 
controlling in the position of the Puma 560 robot manipulator in terms of position tracking error. 


6. CONCLUSION 

All simulation were presented using MATLAB and Robotics Toolbox (Peter Corke). 
From the simulation results, we conclude that performance of the fuzzy logic controller in term of position 
tracking error in case of existence disturbance or load is better than the performance of a computed torque 
controllers (PD-CTC and PID-CTC). 
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